#ifndef PLANNER_PKG__PLANNER_UTIL_HPP_
#define PLANNER_PKG__PLANNER_UTIL_HPP_

#include <memory>
#include "vector"
#include "geometry_msgs/msg/pose.hpp"
#include "geometry_msgs/msg/point.hpp"
#include "nav_msg_pkg/msg/waypoint.hpp"

namespace planner_util
{

    // 两个点位之间的距离
    double pointDistance(int x1, int y1, int x2, int y2);
    
}

#endif // PLANNER_PKG__PLANNER_UTIL_HPP_